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(54) ROBOT DEVICE AND METHOD OF CONTROLLING ROBOT DEVICE OPERATION 



(57) A robot apparatus is provided which includes 
body portions such as a head block (4), leg blocks (3A 

to 3D), an actuator (25) to actuate the body portions and 
a CPU (1 0) to supply a control signal to the actuator (25). 
In this apparatus, information about an external force 
applied to the apparatus, such as the position, magni- 
tude, direction, etc. of the external force, is computed 
on the basis of changes of the control signal supplied 
from the CPU (1 0) to drive the actuator (25) and a signal 
supplied as a response to the CPU (1 0) when the actu- 
ator (25) Is driven. The external force information is sup- 
plied to the CPU (1 0) and used as information for selec- 
tion of a behavior and emotion of the robot apparatus 
and the next behavior of the apparatus. Thus, in the ro- 
bot apparatus, since the external force information is 
computed on the basis of an output from the CPU (10) 
and outputs from the actuator (25) and a potentiometer 
(26), so an external force can be detected by the use of 
existing devices and no dedicated sensors have to be 
additionally provided. 
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Description 

Technical Field 

5 [0001] The present invention generally relates to a robot apparatus, nnethod of controlling the operation of the robot 
apparatus, external force detecting apparatus and nnethod, program for controlling the operation of the robot apparatus, 
and a recording medium having the program recorded therein, and more particularly to a robot apparatus which au- 
tonomously decide its behavior, and behaves adaptively to its surrounding environment and an external action, a meth- 
od of controlling the operation of such a robot apparatus, an operating controlling program, and a recording medium 

10 having the program recorded therein. 

Background Art 

[0002] Recently, a quadruped robot apparatus which behaves in response to an instruction given by the user of the 
15 robot apparatus and adaptively to the surrounding environment and the like has been developed by the Applicant of 

the present invention, and commercially available. Such a robot apparatus has installed therein a CCD (charge coupled 
device) camera and microphone. Assessing the environmental condition and determining whether or not an instruction 
has been given by the user, based on an environment captured by the CCD camera, and a command voice from the 
user or an ambient sound, picked up by the microphone, the robot apparatus autonomously decides how to behave, 

20 and does the behavior, based on the results of assessment and detennination. 

[0003] However, since the robot apparatuses of the above type are normally used in the ordinary dwellings in which 
there exist many obstacles to the robot apparatus such as doorsills, power cords and the like, some measures have 
to be worked out to prevent the robot apparatus from easily tumbling while walking in such an environment. To this 
end, some solutions have been proposed. One of such solutions is a quadruped robot apparatus which controls its 

25 own behavior by detecting an obstacle based on image signals from the CCD camera and causing itself to detour 
around the obstacle based on the result of detection. Another solution is to provide a special force sensor in each of 
leg blocks of the robot apparatus, and detect, based on an output from the sensor, whether the robot apparatus has 
collided with any obstacle. 

[0004] In the robot apparatus using the CCD camera, however, detecting an obstacle based on the image signals 
30 from the CCD camera takes a long time and it is not possible to recognize an obstacle, if any, at any high success rate. 
Also, the sensors provided in the leg blocks add to the number of parts of the robot apparatus whose construction will 
thus be complicated and production cost and weight will be increased. 

[0005] Further, In case such a robot apparatus is provided with a plurality of sensors In predetenrilned positions, It 
will be able to detect an obstacle and behave as specified (sitting down, for example) correspondingly to a pressed 
35 one of the sensors. Therefore, provision of more sensors on the robot apparatus will pemnit the user of the robot 
apparatus to enjoy higher-level interactions with his or her robot apparatus. 

[0006] However, in case such touch sensors are provided in predetermined positions on the robot apparatus, touch 
can only be detected in the limited positions and thus the interaction of the robot apparatus with its user will be limited. 
For example, use of advanced sensors for detection of a direction in which a force has been applied to the robot 
40 apparatus will also lead to a complicated construction, and an Increased production cost and weight, of the robot 
apparatus. Also, such sensors cannot be provided at all portions of the robot apparatus. 

Disclosure of the Invention 

45 [0007] Accordingly, the present invention has an object to overcome the above-mentioned drawbacks of the con- 
ventional robot apparatuses by providing a simply constructed external force detecting apparatus which can detect a 
collision with an obstacle and also information about the external force such as a direction of the external force, etc., 
a robot apparatus using the external force detecting apparatus, a method of controlling the operation of the robot 
apparatus, a program for controlling the operation of the robot apparatus, and a recording medium having the program 

50 recorded therein. 

[0008] The above object can be attained by providing a robot apparatus Including according to the present invention: 
an actuator whose motion is controlled with a control signal; 

a controlling means for outputting the control signal which causes the actuator do a predetermined motion; and 
55 means for detecting an external force on the basis of a change shown by the control signal when the external force 

Is applied to the actuator. 

[0009] Also, the above object can be attained by providing a method of controlling the operation of a robot apparatus. 
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the method including, according to the present invention, steps of: 

controlling the motion of an actuator of the robot apparatus with a control signal; and 

detecting an external force to the robot apparatus on the basis of a change shown by the control signal when the 
5 external force is applied to the robot apparatus. 

[0010] Also, the above object can be attained by providing an external force detecting apparatus Including according 
to the present invention: 

10 means for actuating each portion of a robot apparatus; 

a controlling means for specifying, to the actuating means, an amount of motion the actuating means has to do 

for actuating the portion; 

means for detecting an actual amount of motion the actuating means has done; and 

means for determining, on the basis of the specified and actual amounts of motion, whether or not an external 
15 force has been applied to the robot apparatus. 

[0011] Also, the above object can be attained by providing an external force detecting method including, according 
to the present invention, steps of: 

20 specifying, to means for actuating each portion of a robot apparatus, an amount of motion the actuating means 

has to do for actuating the portion; 

detecting an actual amount of motion the actuating means has done for actuating the portion: and 

determining whether or not an external force has been applied to the robot apparatus, on the basis of the specif led 

and actual amounts of motion. 

25 

[0012] Also, the above object can be attained by providingaprogramforcontrollingtheoperation of a robot apparatus, 

the program causing the robot apparatus to: 

control the motion of an actuator thereof with a control signal; and 
30 detect an external force to the robot apparatus on the basis of a change shown by the control signal when the 

external force is applied to the robot apparatus. 

[0013] Also, the above object can be attained by providing a recording medium having recorded therein a program 
which causes a robot apparatus to: 

35 

control the motion of an actuator thereof with a control signal; and 

detect an external force to the robot apparatus on the basis of a change shown by the control signal when the 
external force is applied to the robot apparatus. 

40 Brief Description of the Drawings 

[0014] 

FIG. 1 is a functional block diagram of the basic system of the present invention. 
45 FIG. 2 shows a flow of operations made in the basic system in FIG. 1 . 

FIG. 3 shows a program prepared for execution of step S3 in FIG. 2. 

FIG. 4 illustrates, in the form of a perspective view, the appearance of the robot apparatus according to the present 
Invention. 

FIG. 5 is a bloc[< diagram of the circuit construction of the pet robot shown in FIG. 4. 
50 FIG. 6 is a blocl< diagram of the signal processing circuit, 

FIG. 7 is a conceptual block diagram of the software configuration of the control program. 

FIG. 8 Is a conceptual block diagram of the middleware layer. 

FIG. 9 is a conceptual block diagram of the application layer. 

FIG. 10 is a conceptual diagram of the behavior model library. 
55 FIG. 11 is a conceptual diagram of the probability automaton. 

FIG. 12 is a conceptual diagram of the state transition table. 

FIG. 13 is a block diagram of the main system of the robot apparatus, intended to detect an external force to the 
robot apparatus. 
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FIG. 1 4 is a characteristic graph showing the relation between PWM pulse and measured torque at the right fore- 
leg block. 

FIG. 15 is a characteristic graph showing the relation between PWM pulse and measured torque at the left fore- 
leg block. 

5 FIG. 16 is a characteristic graph showing the relation between PWM pulse and measured torque at the right hind- 

leg block. 

FIG. 17 Is a characteristic graph showing the relation between PWM pulse and measured torque at the left hind- 
leg block, 

FIG. 18 shows the configuration of the force sensor system. 
10 FIG. 1 9 Is a characteristic graph showing the calibration used in explanation of the force sensor system. 

FIG. 20 shows the modeled links of the robot apparatus, 

FIG. 21 is a characteristic graph showing the relation, at the joint 1 . between a measured torque and a torque 
obtained through conversion of a force detected by the force sensor. 

FIG. 22 Is a characteristic graph showing the relation, at the joint 1 , between a measured torque and a torque 
15 obtained through conversion of a force detected by the force sensor. 

FIG. 23 IS a characteristic graph showing the relation, at the joint 2, between a measured torque and a torque 
obtained through conversion of a force detected by the force sensor. 

FIG. 24 is a characteristic graph showing the relation, at the joint 2, between a measured torque and a torque 
obtained through conversion of a force detected by the force sensor. 
20 FIG. 25 Is a characteristic graph showing the relation, at the joint 3, between a measured torque and a torque 

obtained through conversion of a force detected by the force sensor. 

FIG. 26 is a characteristic graph showing the relation, at the joint 3, between a measured torque and a torque 
obtained through conversion of a force detected by the force sensor. 

FIG. 27 Is a characteristic graph showing simulated values of a force applied to the standing robot apparatus from 
25 the back. 

FIG. 28 Is a characteristic graph showing simulated values of a force applied to the standing robot apparatus from 

the front. 

FIG. 29 is a characteristic graph showing simulated values of a force applied to the robot apparatus raising the 
left leg block while standing. 

30 FIG. 30 is a characteristic graph showing simulated values of forces applied to the standing robot apparatus from 

the back, left, right and front, respectively in this order. 

FIG. 31 shows waveforms showing the relations between specified amounts of motion for the pitching-dlrectional 
actuator and actual amounts of motion the actuator has done. 

FIG. 32 shows waveforms showing the relations between specified and actual amounts of motion. 
35 FIG. 33 is a conceptual diagram for explanation of the stability margin . 

FIG. 34 shows waveforms for explanation of the stability margin. 

FIG. 35 shows waveforms for explanation of the detection of an obstacle by the first to third obstacle detecting 
methods. 

FIG. 36 shows waveforms for explanation of the detection of an obstacle by the first to third obstacle detecting 
40 methods. 

FIG. 37 shows waveforms for explanation of the detection of an obstacle by the first to third obstacle detecting 
methods. 

FIG. 38 Is a conceptual diagram for explanation of the stability margin computation. 
FIG. 39 shows a flow of operations made for detecting an obstacle. 

45 

Best Mode for Carrying Out the Invention 

[0015] The robot apparatus going to be described below as an embodiment of the present invention is of an auton- 
omous type which autonomously behaves adaptively to its surrounding environment (external factor) and internal state 

50 (internal factor). The external factors include a force applied by the user thereto, an externa! force caused by a touch 
with an obstacle, etc. The robot apparatus is designed to detect an external force applied thereto. 
[0016] In addition to the basic system for the autonomous behavior to be made based on external and internal factors, 
the robot apparatus includes an external force sensor 1 01 , external force analyzer 1 02 and a behavior selector 1 03 
as shown In FIGS. 1 and 2. In step SI , the external force sensor 1 01 measures the position, direction and magnitude 

55 of an external force applied to the robot apparatus. Then, In step S2, the external force analyzer 102 sorts the measured 
external force according to signals supplied from the external force sensor 101. Further in step S3, the behavior selector 
103 causes the robot apparatus to change its posture accordingly to the result of the external force analysis made by 
the external force analyzer 102. 



4 



EP 1 386 699 A2 



[0017] In step S3, the behavior selection is done according to a progrann sliown in FIG. 3 for example. The progrann 
shown in FIG. 3 is prepared so that the next behavior can be selected based on the kind of an external force applied 
to the robot apparatus and behavior status of the robot apparatus, In the program, the variables "ForceKind", "Behav- 
iorStatus" and"ForceDirection" indicate a position at which the external force is applied^ behavior of the robot apparatus 
5 and a direction in which the external force is applied, respectively. The behavior selector 1 03 selects a behavior based 
on these pieces of Information about the external force, 

[0018] The present Invention will be described in detail concerning an external force detecting method adopted in 
the autonomous robot apparatus designed to select a behavior based on an applied external force. 

10 (1 ) General description of the robot apparatus 

[0019] FIG. 4 shows a robot apparatus 1 shaped like an animal such as "dog", namely, a pet robot. As shown, the 
robot apparatus 1 is composed of a body block 2, leg blocks 3A, 3B, 3C and 3D joined to the front and rear and right 
and left portions, respectively, of the body block 2, a head block 4 and tail block 5 joined to the front and rear ends, 

15 respectively, of the body block 2. 

[0020] As shown in FIG. 5, the body block 2 houses a controller 16 including a CPU (central processing unit) 10, 
DRAM (dynamic random-access memory) 11, flash ROM (read-only memory) 12^ PC (personal computer) card inter- 
face circuit 13 and a signal processing circuit 14, connected to each other via an internal bus 15, and a battery 17 as 
a power source for the robot apparatus 1 . The body block 2 houses also an angular velocity sensor 18, acceleration 

20 sensor 1 9, etc. which detect the direction and acceleration of a motion of the robot apparatus 1 . 

[0021] The head block 4 has disposed in place therein a CCD (charge-coupled device) camera 20 to capture the 
outside circumference, a touch sensor 21 to detect a pressure applied to the robot apparatus 1 when the user makes 
a physical action on to the robot apparatus 1 such as "patting" or "hitting", a distance sensor 22 to measure the distance 
from the robot apparatus 1 to an object existing before it, a microphone 23 to pick up an external sound, a speaker 24 

25 to output a sound such as yelping, LEDs (light-emitting diode) (not shown) equivalent to the "eyes" of the robot appa- 
ratus 1 . 

[0022] Further, the joints of the leg blocks 3A to 3D, links between the leg blocks 3A to 3D and body block 2, link 
between the head block 4 and body block 2, link between a tail 5A and tail block 5, etc. have disposed therein actuators 
25^ to 25n and potentiometers 26^ to 26^ for their respective degrees of freedom. For example, each of the actuators 
30 25^ to 25n is a servo motor. The leg blocks 3A to 3D are controlled by their respective servo motors to take a target 

posture or do a specified motion. 

[0023] The sensors Including the angular velocity sensor 18, acceleration sensor 19, touch sensor 21, distance 
sensor 22, microphone 23, speaker 24 and potentiometers 26^ to 26p, and the LEDs and actuators 26^ to 25n, are 
connected to the signal processing circuit 14 In the control unit 1 6 via hubs 27^ to 27^, respectively. The CCD camera 

35 20 and battery 17 are connected directly to the signal processing circuit 14. 

[0024] The signal processing circuit 14 sequentially acquires sensor data, image data and sound data from the 
sensors and sequentially stores the data in place in the DRAM 11 via the internal bus 15. Also, the signal processing 
circuit 14 acquires residual-potential data from the battery 17, and stores the data in place in the DRAM 11 . 
[0025] The sensor data, image data, sound data and battery residual-potential data stored in the DRAM 11 are 

40 subsequently used by the CPU 10 for controlling the operation of the robot apparatus 1 . 

[0026] Actually in the initial operation just afterthe robot apparatus 1 is turned on, the CPU 1 0 reads a control program 
from a memory card 28 set in a PC card slot (not shown) in the body block 2 or the flash ROM 12 via the PC card 
Interface circuit 13 or directly, and stores the program into the DRAM 11 , 

[0027] Thereafter, based on the sensor data, image data, sound data and battery residual-potential data sequentially 
45 stored into the DRAM 11 from the signal processing circuit 14 as above, the CPU 10 determines the internal status 
and surrounding environment of the robot apparatus 1, and whether or not the user has made any Instruction and 
action to the robot apparatus. 

[0028] The CPU 10 decides the next behavior on the basis of the result of determination and the control program 

stored in the DRAM 11 , and drives corresponding ones of the actuators 25-j to 25^ on the basis of the determination 
50 to turn the head block 4 vertically or horizontally, move the tail 5A of the tail block 5, and actuate the leg blocks 3A to 
3D for walking, for example. 

[0029] Also, the CPU 1 0 generates sound data when necessary and supplies it as a sound signal to the speaker 24 
via the signal processing circuit 14 to output a sound based on the sound signal, or turns on and off or flicker the LEDs. 
[0030] As above, the robot apparatus 1 can autonomously behave adaptlvely to its own status and surrounding 
55 environment and in response to an instruction and action from the user. 
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(1-1) Signal processing circuit 

[0031] As shown in detail in FIG. 6, the signal processing circuit 14 includes a DMA (direct memory access) controller 
30, DSP (digital signal processor) 31 , peripheral interface 32, timer 33, FBK/CDT (filter bank/color detector) 34, IPE 
5 (inner product engine) 35, serial bus host controller 36 and serial bus 37, connected to a bus 40 via a bus 38 and an 
arbiter 39 which arbitrates the right of using the bus 38 in this order. The bus 40 is connected to the DRAM 11 (shown 
in FIG. 5), CPU 10 (in FIG. 5) and flash ROM 12 (In FIG. 5) via a DRAM interface 41, host interface 42 and ROM 
interface 43, respectively, and a parallel portion 44, battery manager 45 and serial portion 46 are connected to the 
peripheral interface 32. 

10 [0032] The devices including the angular velocity sensor 18, acceleration sensor 19, touch sensor 21 .distance sensor 

22, microphone 23, speaker24, actuators 25 (25^, 252, 253, ...), potentiometers 26 (26^, 263, 263, .,.), etc. having been 
described above with reference to FiG. 5 are connected to the serial bus host controller 36 via the hubs 27 (27^ to 
27^), respectiveiy. The CCD camera 20 (shown In FIG. 2) is connected to the FBK/CDT 34, and the battery 1 7 (in FIG. 
5) Is connected to the battery manager 45. 

15 [0033] The serial bus host controller 36 Is sequentially supplied with sensor data from the angular velocity sensor 
1 8, acceleration sensor 1 9, touch sensor 21 , distance sensor 22, microphone 23, speaker 24, potentiometers 26 (26-| , 
262, 263, ...), etc, of the devices connected thereto, and stores the data into the DRAM 11 via the bus 38, bus arbiter 
39, bus 40 and DRAM interface 41 in this order under the control of the DMA controller 30 which functions as a bus 
master to control the data transfer. 

20 [0034] Also, the serial bus host controller 36 sends sound data from the microphone 23 to the DSP 31 which will 
process the sound data in a predetermined manner, transfers the sound data thus processed to the DRAM 11 via the 
bus 38, bus arbiter 39, bus 40 and DRAM interface 41 in this order under the control of the DRAM controller 30, and 
thus stores the sound data in a predetermined storage area in the DRAM 11 . 

[0035] The FBK/CDT 34 acquires image data from the CCD camera 20 while making color recognition of the data 
25 to sort the data according to a plurality of resolutions, transfers the image data to the DRAM 11 (in FIG. 5) via the bus 
38, bus arbiter 39, bus 40 and DRAM interface 41 in this order under the controi of the DMA controller 30, and thus 
stores the image data in a specified storage area in the DRAM 11 as wiii be described later, 
[0036] Further, the battery manager 45 transfers the battery residual-potential data send from the battery 17 and 
indicating an energy remaining in the battery 17 to the DRAM 11 via the peripheral interface 32, bus 38, bus arbiter 
30 39, bus 40 and DRAM interface 41 in this order under the control of the DAM controller 30, and thus stores the data 
in a predetermined storage area of the DRAM 11 . 

[0037] On the other hand, the signal processing circuit 14 is supplied, via the host Interface 42, with a first drive 
signal to drive the actuators 25 (25^, 262, 263, ...), sound signal and a second drive signal to drive the LEDs, given 
from the CPU 10 (in FIG, 5) via the bus 15 (In FIG. 5) as above. 
35 [0038] Then, the signal processing circuit 14 sends the signals to corresponding ones of actuators 25 (25^, 262; 
253, ..,) (in FIG. 5), speaker 24 (in FiG. 5) or LEDs via the bus 40, bus arbiter 39, bus 38, serial bus host controller 36 
and corresponding hubs 27 (27^ to 27^) (in FIG. 5) in this order. 

[0039] As above, the signal processing circuit 14 is provided between the CPU 10 and the devices such as the 
sensors, CCD camera 20, microphone 23, speaker 24, actuators 25 (25^, 252; 263, ...), etc. and can make various 
40 kinds of signal processing necessary for the CPU 1 0 to control the behavior of the robot apparatus 1 . 

(1 -2) Software configuration of the control program. 

[0040] Ne>ct, the software configuration of the controi program adopted in the robot apparatus 1 will be described. 

45 [0041] FIG. 7 shows the software configuration of the above-mentioned control program used in the robot apparatus 
1 . As shown, the control program includes a device driver layer 50 laid in the bottom layer thereof and formed from a 
device driver set 51 composed of a plurality of device drivers. In this program, each of the device drivers 51 Is an object 
allowed to access directly the CCD camera 20 (in FIG. 5) and an ordinary computer hardware such as a timer, and 
works upon interruption from a corresponding hardware. 

50 [0042] The control program includes also a robotic server object 52 laid above the device driver layer 50. The robotic 
server object 52 is composed of a virtual robot 53 fomried from a software group which provides an interface for access 
to the hardware such as the aforementioned sensors and actuators 25 (25^ to 25^), a power manager 54 fomned from 
a software group which manages selection between the batteries, a device driver manager 55 formed from a software 
group which manages the other various device drivers, and a designed robot 56 formed from a software group which 

55 manages the mechanism of the robot apparatus 1 . 

[0043] The control program includes also a manager object 57 composed of an object manager 58 and service 
manager 59. In this control program, the object manager 58 is a software group which manages start and end of each 
of software groups included in the robotic server object 52, middleware layer 60 and application layer 61 . The service 
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manager 59 is a software group which manages connection between the objects on the basis of inter-object connection 
information stated in a connection file stored in the memory card 28 (in FIG. 5). 

[0044] The middleware layer 60 is formed from a software group laid above the robotic server object 52 to provide 
basic functions of the robot apparatus 1 such as Image processing and sound processing. The application layer 61 is 

5 formed from a software group laid above the middleware layer 60 to decide a behavior of the robot apparatus 1 on the 
basis of the result of a processing having been made by each software group included in the middleware layer 60. 
[0045] The concrete software configurations of the middleware layer 60 and application layer 61 are shown in FIGS. 
8 and 9, respectively. As seen from FIG. 8, the middleware layer 60 is composed of a recognition system 700 including 
signal processing modules 70 to 78 to detect a noise, temperature, brightness, scale, distance, posture, touch, motion 

10 and color respectively, and an input semantics converter module 79, and an output system 800 Including an output 
semantics converter module 88 and signal processing modules 81 to 87 provided for posture management, tracking, 
motion reproduction, walking, recovery from overturn, LED turn-on and sound reproduction, respectively 
[0046] In this embodiment^ the signal processing modules 70 to 78 included in the recognition system 700 acquire 
corresponding ones of the sensor data, image data and sound data read by the virtual robot 53 in the robotic server 

15 object 52 from the DRAM 11 (In FIG. 5), make a predetennined processing on the basis of the data, and supply the 
result of processing to the input semantics converter module 79. 

[0047] The input semantics converter module 79 recognizes, on the basis of the result of processing supplied from 
the signal processing modules 70 to 78, the Internal status and surrounding environment of the robot apparatus 1 and 
an Instruction and action from the user, such as "noisy", "hot", "bhght", "the robot apparatus detected a ball", "the robot 
20 apparatus detected Itself tumbled", "the robot apparatus was patted", "the robot apparatus was hit", "the robot apparatus 
heard scales "do", "mi" and "so", "the robot apparatus detected a moving object" or "the robot apparatus detected an 
obstacle"; and outputs the results of recognition to the application layer 61 (in FIG. 7). 

[0048] As shown in FIG. 9, the application layer 61 is composed of five modules including a behavior model library 
90, behavior selection module 91 , learning module 92, emotion model 93 and an instinct model 94. 
25 [0049] In this embodiment, the behavior model library 90 includes independent behavior models 90i to 90^ corre- 
sponding to some pre-selected conditional Items such as "the battery residual-potential has become low", "the robot 
apparatus recovers from overturn", "the robot apparatus expresses an emotion", "the robot apparatus has detected a 
ball", etc. as shown in FIG. 10. 

[0050] When supplied with the results of recognition from the Input semantics converter module 76 or upon elapse 
30 of a predetermined time after the last result of recognition is supplied, the behavior models 90^ to 90^ decide the next 
behavior while referring to a corresponding emotion parametric value held in the emotion model 93 and a corresponding 
desire piece parametric value held in the instinct model 94 as necessary as will be described later, and supply the 
result of decision to the behavior selection module 91 . 

[0051] Note that In this embodiment, each of the behavior models 90^ to 90^ uses, for deciding the next behavior, 
35 an algorithm called "probability automaton" to stochastically decide, on the basis of transition probabilities to P^^^ 
set for arcs ARC^ to ARCf^^^ connecting the nodes NODEq to NODEp to each other, which one of nodes NODEq to 
NOD En (as shown in FIG. 1 1 ) is a transition source and which other one of the nodes NODEq to NODEp is a transition 
destination. 

[0052] More specifically, each of the behavior models 90^ to 90^ has a state transition table 1 00, as shown In FIG. 
40 12, for each of the nodes NODEq to NODE^ forming the behavior models 90^ to 90^. 

[0053] The state transition table 100 has events (results of recognition) being conditions for transition from one to 
another of the nodes NODEq to NODE^ listed in lines thereof corresponding to a column "Input event name" thereof 
In the order of priority, and further such transition conditions listed in lines con'esponding to columns "Data name" and 
"Data range". 

45 [0054] Therefore, according to the state transition table 100 in FIG. 12, the robot apparatus 1 can transit in state 
from the node 100 to any other node only when the size of the ball (SIZE), given together with the result of recognition, 
is within a range "0 to 1000" In case the result of recognition is "the robot apparatus detected a ball (BALL)", or only 
when the distance (DISTANCE) from the robot apparatus 1 to the obstacle, given together with the result of recognition, 
is within a range of "0 to 1 00" in case the result of recognition is "the robot apparatus detected an obstacle (OBSTACLE)". 

50 [0055] Also, according to the state transition table 1 00, the robot apparatus 1 can transit in state from the node 1 00 
to any other node when any one of "JOY", "SURPRISE" and "SADNESS" among parametric values of emotions and 
desire pieces, held in the emotion model 93 and instinct model 94 to which the behavior model 90^ to 90^ cyclically 
refer, has a value within a range of "50 to 100" even if no result of recognition is supplied. 

[0056] Also In the state transition table 1 00, there Is written In a line "Transition destination node" corresponding to 
55 a column "Probability of transition to other node" the names of nodes to which the robot apparatus 1 can transit in state 
from any one of the nodes NODEq to NODEp, there is written in a line corresponding to the column "Probability of 
transition to other node" a probability of transition with which the robot apparatus 1 can transit in state to other one of 
the nodes NODEq to NODE^ when all the conditions written in lines "Input event name", "Data value" and "Data range" 
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are met, and there is written in a tine "Output behavior" corresponding to the "Probability of transition to other node" a 
behavior to be made by the robot apparatus 1 when it transits in state to the above node among the nodes NODEo to 
NOD En- It should be noted that the sum of probabilities in the lines corresponding to the column "Probability of transition 
to other node" is 100 (%). 

5 [0057] Therefore, according to the state transition table 100 in FIG. 12, the robot apparatus 1 can transit in state 
from the node 100 to the node "node 120" with a probability of "30 {%)" when it has been recognized that "the robot 
apparatus detected a ball (BALL)" and "the size of the ball (SIZE)" is within a range of "0 to 1000", and the output 
behavior will be "ACTI0N1". 

[0058] Each of the behavior models 90^ to 90^ is composed of a plurality of the nodes NODEq to NODE„ connected 
10 to each other as written in the above state transition table 100. When supplied with a result of recognition from the 

input semantics converter module 76 or so, the behavior model stochastically decides the next behavior by the use of 
the state transition table 100 of a corresponding one of the nodes NODEpto NODE^, and supplies the result of decision 
to the behavior selection module 91 . 

[0059] The behavior selection module 91 selects, from behaviors outputted from the behavior models 90i to 90n, 
15 respectively; of the behavior model library 90, ones outputted from the behavior models 90^ to 90n, having higher 

predetermined priority, and sends a command for malting a behavior (will be referred to as "behavior command" here- 
under) to the output semantics converter 88 in the middleware layer 60. It should be noted that in this embodiment, 
the lowest one of the behavior models 90^ to 90^ In FIG. 10 Is set to have the highest priority and the highest one Is 
set to have the lowest priority. 

20 [0060] Also, based on behavior completion information supplied from the output semantics converter 88 after com- 
pletion of a behavior, the behavior selection module 91 informs the learning module 92, emotion model 93 and Instinct 

model 94 of the completion of the behavior. 

[0061] On the other hand, the learning module 92 is supplied with a result of recognition of a teaching given as an 
action from the user, such as "hit" or "patted", among the results of recognition supplied from the input semantics 
25 converter 79. 

[0062] Then the learning module 92 will change the probability of transition of a corresponding one of the behavior 
models 90-| to 90^ in the behavior model library 90 on the basis of the result of recognition and information from the 
behavior selection module 91 to lower the probability of execution of the behavior when the robot apparatus 1 has 
been "hit (scolded)", while raising the behavior execution probability when the robot apparatus 1 has been "patted 
30 (praised)". 

[0063] On the other hand, the emotion model 93 holds a parametric value indicative of the strength of each of six 
emotions including "joy", "sadness", "anger", "surprise", "disgust" and "fear". The emotion model 93 cyclically renews 
the parametric values of these emotions according to special results of recognition such as "hit", "patted" and the like 
supplied from the input semantics converter module 79, elapsed time and information from the behavior selection 
35 module 91. 

[0064] IVlore particularly, the emotion model 93 computes; by a predetermined algorithm, a variation of the emotion 
at a time on the basis of a recognition result supplied from the input semantics converter module 79, a behavior of the 
robot apparatus 1 at that time and an elapsed time from the last renewal. Then, taking the emotion variation as AE[t], 
current parametric value of the emotion as E[t] and coefficient indicating the sensitivity to the emotion as kg, the emotion 
40 model 93 detemiines a parametric value E[t+1] of the emotion In the next cycle by computing an equation (1), and 
replaces the previous parametric value E[t+1] with the current parametric value E[t] of the emotion, to thereby renew 
the parametric value of the emotion. The emotion model 93 similarly computes the equation (1) to renew the parametric 
values of all the remaining emotions. 

E[t+1]=E[t] + k3XAE[t] (1) 

[0065] Note that it is predetermined how much each recognition result and the Information from the output semantics 

converter module 88 influence the variation AE[t] of the parametric value of each emotion. The predetermination is 
^0 such that for example, the result of recognition of "hit" will have an greater influence on the variation AE[t] of the 
parametric value of the "anger" emotion, while the result of recognition of "patted" will have a greater influence on the 
variation AE[t] of the parametric value of the "joy" emotion. 

[0066] The Infonnation from the output semantics converter module 88 Is feed-back information on behavior (behav- 
ior-completion information). Namely, it is information on the result of behavior execution. The emotion model 93 will 
55 change the emotion with such information. For example, "whining" behavior will lower the level of "anger" emotion. It 
should be noted that the infomiatlon from the output semantics converter module 88 Is also supplied to the aforemen- 
tioned learning module 92 which will change, based on the Information, the probabilities of transition corresponding to 
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the behavior models 90i to 90^. 

[0067] Note that the result of behavior may be fed back by an output (behavior having a feeling added thereto) of 
the behavior selection module 91 . 

[0068] On the other hand, the instinct model 94 holds a parametric value indicative of the intensity of each of four 
5 desire (instinct) pieces including "exercise", "affection", "appetite" and "curiosity". The instinct model 94 cyclically re- 
news the parametric values of these desire pieces according to the results of recognition supplied from the input se- 
mantics converter module 79, elapsed time, information from the behavior selection module 91 , etc. 
[0069] More particularly, the instinct model 94 computes, by a predetemnined algorithm, a variation of each of instinct 
(desire) pieces including "exercise", "affection", "appetite", and "curiosity" at a time on the basis of a recognition result, 
10 elapsed time and information from the output semantics converter module 88. Then, taking the desire piece variation 
as Al[k], current parametric value of the desire piece as l[k] and coefficient indicating the sensitivity to the desire piece 
as kj, the instinct model 94 computes a parametric value l[k+1] of the desire piece in the next cycle by computing an 
equation (2) in a given cycle, and replaces the value l[k+1] with the current parametric value l[k] of the desire piece, 
to thereby renew the previous parametric value of the desire piece. The instinct model 94 similarly computes the 
15 equation (2) to renew the parametric values of all the remaining pieces of Instinct (desire) except for the "appetite". 

![k+1]=l[k] + ki X Al[k] (2) 

20 [0070] Note that it is predetennined how much each of the recognition results and the infonnation from the output 

semantics converter module 88 influence the variation Al[k] of the parametric value of each desire piece. The prede- 
termination is such that for example, the information from the output semantics converter module 88 wilt have a great 
Influence on the variation Al[k] of the parametric value of "fatigue" state. 

[0071] Note that in this embodiment, the parametric values of the emotions and desire (instinct) pieces are defined 
25 to vary within a range of 0 to 1 00, and the coefficients k^ and k| are also set for each of the emotions and desire pieces. 
[0072] On the other hand, the output semantics converter module 88 of the middleware layer 40 supplies, as shown 
in FIG. 9, a corresponding one of the signal processing modules 78 to 84 of the output system 800 with an abstract 
behavior command such as "go ahead", "joy", "whine" or "track (a ball)" having been supplied from the behavior se- 
lection module 91 of the application layer 61 as above. 
30 [0073] When supplied with the above behavior command, the signal processing modules 81 to 85 generate, on the 
basis of the behavior command, a servo command for supply to a corresponding one of the actuators 25^ to 25^ (in 
FIG. 5), sound data from the speaker 24 (in FIG. 5) and/or drive data for supply to the "eyes'* LEDs, and sequentially 
sends these data to the corresponding one of the actuators 25^ to 25^, speaker 24 or LEDs via the virtual robot 53 of 
the robotic server object 52 and signal processing circuit 14 (In FIG. 5) in this order 
35 [0074] As above, the robot apparatus 1 can do, under the control program, an autonomous behavior adaptively to 
its internal state and surrounding environment, instruction and action from the user 

[0075] When supplied with the above behavior command, the signal processing modules 81 to 87 generate, on the 
basis of the behavior command, a servo command for supply to a corresponding one of the actuators 25^ to 25^ (in 

FIG. 5), sound data from the speaker 24 (in FIG. 5) and/or drive data for supply to the "eyes" LEDs, and sequentially 
^0 sends these data to the corresponding one of the actuators 25^ to 25^, speaker 24 or LEDs via the virtual robot 53 of 
the robotic server object 52 and signal processing circuit 1 4 (in FIG. 12) in this order. 

[0076] As above, the robot apparatus 1 can do, under the control program, an autonomous behavior adaptively to 
its internal state and surrounding environment, Instruction and action from the user 

(2) First method of detecting external force in the embodiment 

[0077] The robot apparatus 1 further includes an external force sensor 7 to detect an external force applied to the 
robot apparatus 1 as shown in FIG. 1 3. When an external force is applied to the robot apparatus 1 , the external force 

sensor 7 detects the external force on the basis of a change shown by a control signal supplied from a controller 6 to 
50 an actuator 8 and destined for controlling moving parts 9 when the external signal is applied to the robot apparatus 1 . 
[0078] The external force sensor 7 is a module or object which is a processing program. Also, the controller 6 includes 
a CPU 10, for example. The moving parts 9 include the aforementioned leg blocks 3A to 3D, head block 4 or tail block 
5, etc. The control signal is a pulse having the width thereof modulated by data, namely, a PWM (pulse width modulation) 
pulse, for example. The PWM pulse is often used as a control signal. 
55 [0079] Because of the aforementioned robot apparatus construction, an external force applied to the robot apparatus 
1 can be detected as follows: 

[0080] The controller 6 supplies a control signal to one of the moving parts 9. The robot apparatus 1 has a plurality 
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of predetermined behavior program data, for example. The behavior program data are information about behaviors 
which can be executed by the robot apparatus 1 . Namely, the robot apparatus 1 can execute various behaviors ac- 
cording to the plurality of behavior program data, The controller 6 selects one of the plurality of thus prepared behavior 
program data under given conditions, and generates a control signal based on the selected behavior program data. 
5 The given conditions include for example that an emotion defining a behavior of the robot apparatus 1 is at a prede- 
termined level. 

[0081] The control signal from the controller 6 is supplied to the actuator 8. The actuator 8 controls the moving part 
9 based on the control signal, and also controls the moving part 9 according to control signals supplied one after another 
from the controller 6 based on the behavior program data. 

10 [0082] The external force sensor 7 monitors the control signal supplied from the controller 6 to the actuator 8 as 
above to detect an external force on the basis of a change shown by the control signal when the external force Is 
applied to the moving part 9, For example, when the control signal is a PWM pulse, the externalforcesensor 7 detects 
an external force on the basis of a change in width shown by the PWM pulse when the external force is applied to the 
moving part 9. Thus, the external force sensor 7 detects the external force. Also, the external force sensor 7 acquires 

^5 the direction and magnitude of the external force as Infomriatlon about the external force. 

[0083] The robot apparatus 1 constructed as above can have the posture and operation thereof controlled according 
to a control signal, and detect an external force based on the control signal. For example, when the robot apparatus 
1 has the body thereof pushed backward with an externa! force, it generates a control signal to control its posture 
against the backward movement and can acquire Information about the external force on the basis of the control signal. 

20 [0084] Then, with external force information and specified operations being linked to each other, for example, the 
robot apparatus 1 can detect, when applied with an external force, information about the external force, and do a 
specified behavior ("sit down" for example) corresponding to the external force. 

(2-1 ) Concrete example of the external force detection 

25 

[0085] Next, the detection of an externa! force will be described in detail below. In the foregoing, there has been 
described the computation, using a PWM pulse as a control signal, of information about an external force (direction, 
magnitude, etc.) applied to the robot apparatus 1 . Here will be described a concrete example of the acquisition of 
information about an external force on the basis of such a PWM pulse. External force information is acquired on the 
30 basis of a PWM puise generally in the following four steps. 

[0086] In a first step, there is determined a relation between a torque A (measured value) and a PWM pulse. 
[0087] In a second step, there is determined a relation between a force detected by a sensor or the like (measured 
value) and a torque B (computed value). 

[0088] In a third step, there is detemiined a relation (relational expression) between the torques A and B. 
35 [0089] In a fourth step, the relation determined in the third step is used to acquire information about the force solely 

from the PWM pulse computed for each of the joints. 
[0090] Each of the above steps will be described in detail. 

(2-1 -1 ) Detennlnation of the relation between measured torque and PWM pulse (first step) 

40 

[0091 ] The relation between a measured torque and PWM pulse is determined on the basis of a relational expression 

as follows: 

[0092] FIGS. 1 4 to 1 7 graphically show the relation between a measured torque and PWM pulse for each of the leg 

blocks, In the graph, the vertical axis indicates the PWM pulse and the horizontal axis indicates the torque value. FIG. 

45 1 4 shows the torque/PWM pulse relation for the right fore-leg block, FIG, 15 shows the torque/PWM pulse relation for 
the left fore-leg block, FIG. 16 shows the torque/PWM pulse relation for the right hind-leg block, and FIG. 17 shows 
the torque/PWM pulse relation for the left hind-leg block. Each of the relations at the fore-leg blocks (or hind-leg blocks) 
is a one between a torque at each of joints (joints 1 to 3) of each fore-leg block (or each hind-leg block), counted from 
the shoulder (or hip) to toe, and a PWM pulse. The torque was measured by pulling the leg block with a spring balance 

50 for example, and the width of the PWM pulse is a one acquired at that time. 

[0093] As shown in FIGS, 1 4 to 1 7, the above relations for all the leg blocks are qualitatively the same as each other. 
For example, in all of the relations, the torque shows no change (for example, the motor does not run) even when a 
PWM pulse exists, namely, there exists a so-called dead zone. For example, the dead zone is within a range of ±320. 
In such a dead zone, the torque is variable and thus unusable for determination of a force. Therefore, a range of PWM 

55 pulse usable to detect a force is selected, and a relation is determined, using a regression line, from a value of the 
selected range. Further, a regression line is computed for each of the joints and the values of regression line, thus 
computed, are averaged to acquire a relational expression. 

[0094] As seen from FIGS. 1 4 to 1 7, the ranges of PWM pulse usable to detect a force are from +320 to +51 2 and 
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from - 320 to -512, respectively. A regression line used to determine a torque when the PWIVI pulse is within a range 
of +320 to +520 is given as the following formula (3): 



10 



y=26 X X - 7245 (3) 

where y is a torque value and x Is a PWM pulse value. On the other hand, a regression line used to determine a torque 
when the PWM pulse is within a range of - 320 to -512 is given as the following formula (4): 

y = 28 X X + 8051 (4) 



[0095] A relational expression indicating a relation between a measured torque and PWM pulse can be acquired as 
the above formula. 

15 

(2-1 -2) Determination of the relation between torque measured by a sensor or the like and torque (computed value) 

(second step) 

[0096] Conversion of a torque applied to the robot apparatus 1 into a torque will be described herebelow. 

20 

(2-1 -2-1 ) Force sensor system 

[0097] FIG, 1 8 shows a system to measure a force (will be referred to as "force sensor system" hereunder) applied 
to the robot apparatus 1. As shown, the force sensor system includes a sensor 201, differential amplifier 202, A/D 

25 converter 203, interface 204 and analyzer 205. 

[0098] The sensor 201 is a triaxial force sensor, for example. The sensor 201 in this embodiment includes three 
uniaxial force sensors 201 a disposed in three different directions and each in contact with a metal ball 201b. Because 
of this construction of the sensor 201 , each force sensor 201 a detects an external force applied to the metal ball 201b 
and generates a signal corresponding to the external force. For example, each force sensor 201a is a strain gauge, 

30 and the sensor 201 is a bridge circuit formed from such strain gauges. 

[0099] The signal generated by the sensor 201 is supplied to the differential amplifier 202 in which it will be amplified 
and supplied to the A/D converter 203. The A/D converter 203 is an 8-bit data converter, for example. Data output from 
the A/D converter 203 Is converted In voltage level by the Interface 204 which Is an RS232C or the like, and supplied 
to the analyzer 205. 

35 [0100] The analyzer 205 analyzes the external force based on the data obtained by means of the sensor 201 . The 

analyzer 205 thus acquires a direction and magnitude of the external force as external-force information. The analyzer 
205 includes, for example, an analysis software and a personal computer (PC) which analyzes an external force applied 
to the robot apparatus 1 according to the description of the analysis software. 

[0101] FIG. 1 9 Is a characteristic graph Intended for calibration of external force. For the calibration, for example, a 
40 balance is used to check an output voltage provided from the differential amplifier 202 when the robot apparatus 1 Is 

applied with a force. As will be seen from FIG. 1 9, the output voltage and weight are proportional with each other. 
[0102] Taking a measured output voltage as V, a force F is given as follows: 



V = VO + F X (VI - V0)/(W1 - WO) 

F = (V - VO) X (W1 -W0)/(V1 - VO) (5) 

[0103] The force sensor system having been described above can be used to measure a force applied to the robot 

50 apparatus 1 . 

(2-1 -2-2) Conversion of measured force into torque 

[0104] There will be described herebelow a conversion formula used to convert a force measured by the aforemen- 
55 tioned force sensor system into a torque. The conversion formula is such that a force as an end effector is converted 
into a torque by modeling links of the robot apparatus 1 . 

[0105] FIG. 20 shows a coordinate system of the modeled links of the robot apparatus 1 , By modeling the links of 
the robot apparatus 1 as shown, a measured force can be converted into a torque. 
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[0106] This force/torque conversion uses the Jacob ian matrix for example. For example, when a force as an end 
effector is taken as F and a torque required for each joint (link) when the force is applied to the robot apparatus 1 is 
taken as t, the Jacobian matrix J can be used to establish a relation between the force and torque as given by the 
following formula (6): 



t = /f 



(6) 



[0107] First, the force/torque conversion between a base coordinate system and link 1 is as follows. The base co- 
ordinate system is a coordinate for the body block 2 of the robot apparatus 1 . The conversion provides a matrix given 
as the following formula (7) taking 3i/2 about the x-axis, -7c/2 about the y-axis and 61 about the z-axis: 
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[0108] Also, the force/torque conversion between the links 1 and 2 provides a matrix given asthefollowingformula (8): 
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Also, the force/torque conversion between the links 2 and 3 provides a matrix given as the following tornnula (9): 



^3 = 



0 0-10 

sin^j cos^ 1 0 

0 0 0 i; 



(9) 



[0109] Also the force/torque conversion between the link 3 and end effector provides a matrix given as the following 
formula (10): 
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(10) 



[01 1 0] By multiplying together the matrices between the base coordinate system and end effector a matrix given as 
the following formula (11) for the force/torque conversion between the base coordinate system and end effector is 
provided: 



(Sff,+C^, -Sff,\Cf, S^, l,{5,C,C3 + C,5,) + lj5A + lo,l 

000 1 



(11) 



[01 1 1 ] Thus, the relations between the origin of the base coordinate system and end effector are given as the following 
formulae (12), (13), (14) and (15): 
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Px = 3(Sl C2C3 + C1S3) + 1 C2 + 1 0x 



Py = ''3S2C3 + l2S2 + V + 



Pz=l3(-ClC2C3 + SiS3)-l2CiC2 



(12) 



dP^/de^ = 13(0,0203 + 3183) + 130,02 

dP/deg = l3(-SiS2S3) - I2S1S2 

dPx/de3 = i3(-SiC2S3 + CiC3) 



(13) 



dPy/de^ = 0 
dPy/de2 = I3C2C3 + I2C2 

dP/dSg = -138283 



(14) 



dP^dei = 13(810203 + 0183) + I281C2 
dP3/de2 = 13(0,8203) + I2C1S2 

dP,/de3 = 13(0,0283 + 3,03) 

[0112] Based on the above results, the Jacobian matrix will be given by the following formula (1 6): 



(15) 



(16) 



[0113] By modeling the links of tlie robot apparatus 1 as above, it is possible to convert a force detected by tlie 
above-mentioned force sensor system into a torque through the conversion using the Jacobian matrix. 

(2-1 -3) Acquisition of force information solely from a PWM pulse computed for each joint using a relation between a 
measured torque and a torque determined by the conversion (steps 3 and 4) 

[0114] The measured torque is the one having been described in item (1-1-1), and the torque determined through 
the conversion is a one detected by the force sensor having been described in item (2-1-2). 
[0115] FIGS. 21 to 26 show, in the form of a characteristic graph, the relation between a measured torque and a 
torque obtained through the conversion of force detected by the force sensor. In each graph, the vertical axis indicates 
a torque (ForceSensor) obtained through the conversion (a value detected by the force sensor) while the horizontal 
axis indicates a measured torque (ApproxEqu). FIGS. 21 and 22 show the relation for the joint 1, FiGS. 23 and 24 
show the relation at the joint 2, and FIGS. 25 and 26 show the relation for the joint 3. FiGS. 21 , 23 and 25 show a 
positive region of the PWIVI pulse, and FIGS. 22, 24 and 26 show a negative region of the PWM pulse. 
[0116] For the joint 1 , the relation given by the following formula (1 7): 
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y= 1.2336X- 866.14 (as in FIG. 21) 

y = 1 .4963X - 231 .59 (as in FIG. 22) (1 7) 

5 

where y is a torque obtained througli the conversion, and x is a measured torque. This is also true for the subsequent 
formula. For the joint 2, the relation given by the following fomnula (1 8): 



y = 0.529X - 7893.45 (as in FIG. 23) 

y = 0.4934x + 910.11 (as In FIG. 24) (18) 



[0117] For the joint 3, the relation given by the following formula (19): 

15 

y = 0.61 1 5x - 51 .28 (as in FIG. 25) 

y = 0.8738X + 1 056.7 (as In FIG. 26) (1 9) 

20 

[0118] An expression of a relation between a force and PWM pulse can be obtained based on the results as shown 
In FIGS. 21 to 26. The relational expression can be used to determine a force from a PWM pulse. It should be noted 
that the relation between a measured torque and a torque obtained through the conversion can also be obtained by 
any other than such a relational expression. 
25 [0119] FIGS. 27 to 30 graphically show simulated values of an applied force, computed using the above-mentioned 
relational expression. 

[0120] FIGS. 27 to 29 show simulated values offerees applied from various directions to the standing robot apparatus 
1 . FIG. 27 is a characteristic graph showing simulated values of forces applied to the standing robot apparatus 1 from 
the bacl<, FIG. 28 is a characteristic graph showing simulated values of forces applied to the standing robot apparatus 

30 1 from the front, and FIG. 29 is a characteristic graph showing simulated values of forces applied to the robot apparatus 
1 raising the left leg block while standing. For example^ the application of a force to the robot apparatus 1 from the 
back as in FIG. 27 is intended to have the robot apparatus 1 lie down. In this case, it will be seen from FIG. 27 that the 
simulated values of the forces to both the right and left fore-leg blocl<s have well been computed and little force is 
applied to the hind-leg blocks because a force applied to the robot apparatus 1 from the back is concentrated to the 

35 fore-leg blocks. 

[0121] FIG, 30 is a characteristic graph showing simulated values of forces applied to the standing robot apparatus 
1 from the back, left, right and front, respectively, in this order. Namely, FIG. 30 shows results of application of a force 
from around the robot apparatus 1 . "Fx" and "Fy" indicate forces applied horizontally. As seen from FIG. 30, the robot 
apparatus 1 positively detects forces applied from around it as above. 
40 [0122] As above, Information (magnitude, direction, etc.) about an external force applied to the robot apparatus 1 
can be computed on the basis of a PWM pulse as a control signal. 

[0123] Namely, the robot apparatus 1 can have the posture and operation thereof controlled according to a control 
signal and use the control signal to detect an external force applied thereto. For example, the robot apparatus 1 can 
also change its posture from one to another using an external force thus detected as a trigger signal. 
45 [0124] Therefore, by pushing the tail block, for example, of the robot apparatus 1 , the user can enjoy to have the 
latter make an action. In this case, the pushing by the user is a trigger signal. 

[0125] Since the robot apparatus 1 detects an external force on the basis of an Initially given control signal, It needs 
no dedicated sensor for detection of the external force. Thus, the robot apparatus 1 can detect an external force by a 
correspondingly simplified construction. 

50 

(3) Second method of detecting external force in the embodiment 

(3-1 ) External force detection in the robot apparatus 1 

55 [0126] Next, the second method of detecting an external force in the robot apparatus 1 according to the present 
Invention will be described. 

[0127] In the robot apparatus 1 , the kinematics and dynamics are applied to compute angles, In pitching and rolling 
directions, of the shoulder joints of the leg blocks 3A to 3D and target angles, in the pitching direction, of the knee joints 
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during walking (the results of computation are taken as specified values), and control corresponding actuators 25 in 
the shoulder joint and knee joint mechanisms so that the pitching- and rolling-directional angles of the shoulder joints 
of the leg blocks 3A to 3D and pitching-directional angles of the knee joints are as specified. Thus the robot apparatus 
1 can walk. 

5 [0128] When the robot apparatus 1 collides with an obstacle while walking, the obstacle will counteract with the robot 
apparatus 1 to apply a force to the shoulder and knee joint mechanisms of the leg blocks 3A to 3D, so that the rotation 
of the shoulder and knee joints cannot attain the specified values in some cases. 

[0129] To avoid the above, the robot apparatus 1 is designed to detect a difference between a specified value of the 
angle in the pitching direction of the shoulder joints, most sensitive to an obstacle, of the leg blocks 3A to 3D, given to 

10 the pitching-directional actuator 25 (will be referred to as "shoulder-joint pitching-directional actuator 25" hereunder), 
and an angle in the pitching direction, obtained based on an output from a potentiometer 26 corresponding to the 
shoulder-joint pitching-directionai actuator 25 (will be referred to as "actuai value" hereunder), and determine, when 
the detected difference is iarger than a preset threshold, that it has coiiided with the obstacle. It should be noted that 
the above method for the fore-leg blocks 3A and 3D will be referred to as "first obstacle detecting method" while the 

15 method for the hind-leg blocks 3C and 3D will be referred to as "second obstacle detecting method", hereunder. 

[0130] FIG. 31 shows the relation between an amount of motion specified to the shoulder-joint pitching-directional 
actuator 25 of the leg blocks 3A to 3D and an actual amount of motion the actuator has done when there exists no 
obstacle. In FIG. 31 , the reference K1 indicates an amount of motion specified to the shoulder-joint pitching-directional 
actuator 25, K2 indicates an actual amount of motion, and K3 indicates a difference between the specified and actual 

20 amounts of motion. As shown In FIG. 31 , the specified and actual amounts of motion do not appear coincident with 
each other, which is caused by some delay taking place in the system after the amount of motion is specified to the 
actuator 25 until it Is actually reflected by the actual amount of motion the actuator 25 has done. By shifting one of the 
graphs horizontally, the two graphs of the specified and actual amounts of motion will appear generally coincident with 
each other. 

25 [0131] Of FIGS. 32A to 320, FIG. 32A shows a waveform of an output K4 provided by the acceleration sensor 1 9 

(in FIG. 5) when the robot apparatus 1 is made to walk and collides with an obstacle, and FIGS. 32B and 320 show 
the relations between an amount of motion specified to the shoulder-joint pitching-directional actuator 25 of the fore- 
and hind-leg blocks 3A to 3D and an actual amount of motion the actuator has done. 

[0132] In FIG. 32B, the reference K5 indicates an amount of motion specified to the shoulder-joint pitching-directional 
30 actuator 25 of the fore-leg blocks 3A and 3B of the robot apparatus 1 , and K6 indicates an actual amount of motion 

detected on the basis of the output from the potentiometer 26 corresponding to the actuator 25. The references K7 to 
K9 indicate an idling phase and landing phase of the fore-leg blocks 3A and 3B, a difference between the specified 
and actual amounts of motion, and a detection signal generated based on whether the difference Is larger than a preset 
threshold, respectively. 

35 [0133] Similarly, in FiG. 320, the reference K10 Indicates an amount of motion specified to the shoulder-joint pitching- 
directional actuator 25 of the hind-leg blocks 30 and 3D of the robot apparatus 1 , K11 indicates an actual amount of 
motion detected on the basis of an output from the corresponding potentiometer 26, and K12 to K1 4 Indicate an idling 
phase and landing phase of the hind-leg blocks 30 and 3D, a difference between the specified and actual amounts of 
motion, and a detection signal generated based on whetherthe difference is largerthan a preset threshold, respectively. 

40 [0134] As seen from FIGS. 32B and 320, there are generated pulses PL1 to PL3 indicating that the robot apparatus 
1 has collided with an obstacle just before it is overturned (shown as encircled in FIG. 32A), as detection signals 
concerning the hind-leg blocks 30 and 3D. More correctly, the pulses PL1 to PL3 indicate that the difference between 
the specified and actual amounts of motion Is largerthan the preset threshold. Therefore, it is possible to detect, the 
first and second obstacle detecting methods, that the robot apparatus 1 has collided with an obstacle. 

45 [0135] However, if any factor other than a collision with an obstacle, such as a thick carpet on which the robot ap- 
paratus 1 walks, for example, causes a resistance against the actuation of the leg blocks 3Ato3D, the first and second 
obstacle detecting methods will detect the resistance like a collision with an obstacle even if there is no actual obstacle. 
In some cases. 

[0136] To prevent such an erroneous detection in the robot apparatus 1 , the threshold for obstacle detection by a 
50 difference between specified and actual amounts of motion in the first and second obstacle detecting methods is set 
higher and another method (will be referred to as "third obstacle detecting method" hereunder) is used to detect a 
collision with an obstacle which cannot be detected by the first and second obstacle detecting methods. 
[0137] Actually, the robot apparatus 1 adopts a concept of "stability margin" in the third obstacle detecting method. 
FIG. 33 shows the concept of the stability margin. As will be seen, the stability margins are defined as distances LI to 
55 L3 from a point defined by projecting the center of gravity of the robot apparatus 1 on the ground surface (will be 
referred to as "projected gravity-center point" hereunder) PG to sides TRE1 to TRE3 of a triangle TR defined by con- 
necting points PA, PB and PD at which three of the leg blocks 3A to 3D (3A, 3B ad 3D in FIG. 33) are on the ground 
surface. 
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[0138] When any of the stability nnargins L1 to L3 takes a negative value, that Is, when the projected gravity point 
PG Is outside the triangle TR, the robot apparatus 1 will overturn. To avoid this, the posture of the robot apparatus 1 
is always controlled while it is walking so that all the stability margins L1 to L3will nottake any negative values. However, 
when the robot apparatus 1 has collided with an obstacle, It will get out of postural balance so that any one of the 

5 stability margins L1 to L3 will go negative or the stability margins L1 to L3 will extremely be small while the stability 
margins LI to L3 are not negative, and thus the robot apparatus 1 will not keep the postural stability. 
[0139] In the robot apparatus 1 , each of the stability margins L1 to L3 is always monitored during walking, and when 
any smallest one of the stability margins L1 to L3 is smaller than a preset threshold, It Is determined that the robot 
apparatus 1 has collided with an obstacle. 

10 [0140] FIG. 33 shows the relation between a theoretical value and measured value of the smallest one of the stability 
margins L1 to L3, which is when the robot apparatus 1 does not actually collide with an obstacle. In FIG. 33, the 
reference K20 indicates a theoretical value, K21 indicates a measured value, and K22 indicates an idling phase and 
landing phase of the leg blocks 3A to 3D. 

[0141] As also evident from FIG. 34, when the robot apparatus 1 does not collide with any obstacle, the theoretical 
15 and measured values of the smallest stability margins L1 to L3 change in the generally same phase. Therefore, it will 
be known that the third obstacle detecting method can be used to detect a collision of the robot apparatus 1 with an 

obstacle. 

[0142] Thus, the robot apparatus 1 uses these first to third obstacle detecting methods one after another to determine 
whether it has collided with an obstacle while walking. When it determines that it has collided with an obstacle, It makes 

20 a predetermined action against overturn by changing the walking manner; walking direction and the like, whereby it 
can effectively prevent itself from being overturned due to the collision with an obstacle. 
[0143] FIGS. 35 to 37 show the results of obstacle detection by the first to third obstacle detecting methods. 
[0144] Each of FIGS. 35 to 37 shows five waveforms. The top four graphs show differences (K30B, K30A, K30C and 
K30D), respectively, between amounts of motion specified to the shoulder-joint pitching-directional actuators 25 of the 

25 leg blocks 3B, 3A, 3C and 3D, that is, right fore-leg, left fore-leg, left hind-leg and right hind-leg blocks, and actual 
amounts of motion the actuators have made, and detection signals (K31B, K31 A, K31Cand K31D), respectively, gen- 
erated depending upon whether the difference is larger than the preset threshold. 

[0145] The fifth graph in FIGS. 35 to 37 show a theoretical value (K32) and measured value (K33) of the smallest 
one of the stability margins L1 to L3, and a detection signal (K34) produced depending on whether the measured value 
30 Is smaller than the preset threshold and intended to detect, by the second obstacle detecting method, whether the 

robot apparatus 1 has collided with any obstacle. 

[0146] In FIGS. 35 to 37, the bottom graphs show an acceleration sensor output (K35) and a detection signal (K36) 
indicating the result of final obstacle detection by the first and second obstacle detecting methods. 
[0147] Of FIGS. 35 to 37, FIG. 35 shows that a collision with an obstacle is detected by the first obstacle detecting 
35 method just before the robot apparatus 1 gets out of postural balance, FIG. 36 shows that the collision Is detected by 
the third obstacle detecting method, and FIG. 37 shows that the collision Is detected by the second obstacle detecting 
method just before the robot apparatus 1 is overturned. 

[0148] Thus, as seen from FIGS. 35 to 37, it could be made sure that the collision with an obstacle can be detected 
positively and with a high accuracy by the first to third obstacle detecting methods before the robot apparatus 1 is 
40 overturned. 

[0149] A concrete method of computing a stability margin will be described below: 

[0150] First, points where three of the leg blocks are on the ground surface are taken as P^q, P^^ and P•^2, respectively, 
as shown in FIG. 38, the kinematics is used to determine coordinates of the points P^o, Pn and P^2 '"^ ^ three-dimen- 
sional space on the basis of joint angles of the leg blocks. 
45 [0151] Next, unit vectors a, b and c of vectors PioPii> ^10^12 ^11^12 determined by the following formulae 
(20), (21) and (22): 

PioPii^l|PioPiill = a (20) 

50 

PioPi2/||PioPi2ll = b (21) 



55 PllPl2/||PllPl2ll=C (22) 

[0152] Then, a directional vector u being a unit vector of an outer product of the vectors a and b is computed using 
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the following formula (23); 

u = axb/||lxb|| (23) 

5 

[0153] Further, the center of gravity of the robot apparatus 1 Is taken as G, and an inner product of the outer product 
(uxa) of the directional vector u and vector a and a vector P1G is computed using the following formula (24). Thus, a 
stability margin s^^^ corresponding to the side P-ioPn can be detennined; 

10 

S^l = (uXa)PiG (24) 

[0154] Note that since the directional vector u and vector a are orthogonai to each other, the outer product (uxa) is "1 ". 
[0155] Also, a stability margin sm2 corresponding to the side P10P11 can be determined similarly by computing an 
Inner product of an outer product (uxb) of the directional vector u and vector b and vector P^G using the following 
formula (25): 

S^2 = (uXb)PiG (25) 

20 

[0156] Also, a stability margin Sf^3 corresponding to the side PiiPi2can be determined by computing an inner product 
of an outer product (uxc) of the directional vector u and vector c and vector P2G using the following formula (26): 

25 S„3 = (uXc)PiG (26) 

[0157] A smaller one of these three stability margins Sn,i, Sj^2 ^m3 ^^^^ computed is selected for comparison 
with a preset threshold, and the third obstacle detecting method can be used to detennined whether the robot apparatus 
1 has collided with an obstacle. 

30 

(3-2) Obstacle detecting procedure RT1 

[0158] The aforementioned obstacle detection in the robot apparatus 1 is done by a CPU 10 (shown In FIG. 4) 

following an obstacle detecting procedure RT1 shown in FIG. 39. 

35 

[0159] In step SPO, the CPU 1 0 starts the obstacle detecting procedure RT1 at the same time as the robot apparatus 
1 starts walking. In step SP1 , It detemriines whether the left fore-leg block 3B Is in the Idling phase. 
[0160] If the CPU 1 0 has determined In step SP1 that the left fore-leg block 3B is not In the Idling phase, It goes to 
step SP4. On the contrary, if the CPU 10 has detennined in step SP1 that the left fore-leg block 3B is in the idling 
phase, it goes to step SP2 where it will compute a difference between the last specified amount of motion the CPU 1 0 
has given to the shoulder-joint pitching-directional actuator 25 in the left fore-leg block 38 and a concurrent actual 
amount of motion In the pitching direction of the shoulder joint, obtained based on an output from the potentiometer 
26 corresponding to the pitching-directional actuator 25. 

[0161] Next in step SP3, the CPU 10 detenntnes whether the difference computed in step SP2 is larger than a 

predetermined threshold, it should be noted that in this embodiment, the threshold is set to 1 8 (deg.). 
[0162] If the result of the determination in step SP3 is negative, the CPU 1 0 goes to step SP4 where it will determine 
whether the right fore-lg block 3A Is In the Idling phase. If the right fore-leg block 3A Is In the idling phase, the CPU 1 0 
goes to step SP5 where it will compute a difference between the last specified amount of motiion the CPU 1 0 has given 
to the shoulder-joint pitching-directional actuator 25 in the right fore-leg block 3A and a concurrent actual amount of 
motion in the pitching direction of the shoulder joint, obtained based on an output from the potentiometer 26 corre- 
spending to the pitching-directional actuator 25. Next In step SP6, the CPU 10 determines whether the difference 
computed In step SP5 Is larger than a predetennined threshold (1 8 deg.), 

[0163] Thus in steps SP1 to SP5, the CPU 1 0 determines, by the first obstacle detecting method, whether the robot 
apparatus 1 has collided with any obstacle. If the CPU 10 has detected a collision with an obstacle by obtaining an 
affirmative result in step SP3 or SP6, it goes to step SP1 6 where it will provide a predetermined overturn prevention 
by causing the robot apparatus 1 to walk in a different manner or direction. Then, the CPU 1 0 goes to step SP1 7 where 
It will store cun^ent values of the hind-leg blocks, and goes back to step SP1 where It will start the obstacle detecting 
procedure RT1 again. 
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[0164] On the contrary, if the CPU 10 has obtained a negative result of the determination in step SP4 orSP6. nannely, 
it has not detected any such collision by the first obstacle detecting method, it goes to step SP7 where it will determine 
whether the left hind-leg block 3D is in the idling phase. 

[0165] If the result of the determined by the CPU 10 in step SP7 is negative, the CPU 10 goes to step SP8 where it 
5 will provisionally memorize that the difference between the last specified amount of motion the CPU 10 has given to 
the shoulder-joint pitching-dlrectional actuator 25 in the left hind-leg block 3C and a concurrent actual amount of motion 
in the pitching direction of the shoulder joint, obtained based on an output from the potentiometer 26 corresponding to 
the pitching-directional actuator 25 is "0", and then goes to step SP11 . 

[0166] On the contrary, if the result of the determination in step SP7 is affirmative, the CPU 10 goes to step SP 9 
10 where It will compute the above difference, and then goes to step SP1 0 where it will determine whether the difference 
computed in step SP9 is larger than a preset threshold and the difference is larger than the preceding one (whether 

the difference has increased). In this embodiment, the preset threshold is set to 15 (deg,). 

[0167] Ifthe result of the determination in step SP10 is negative, the CPU 10 goes to step SP11 where it will determine 
whether the right hind-lg block 3D is in the idling phase. If the right hind-leg block 3D is in the idling phase, the CPU 

15 1 0 goes to step SP1 3 where It will compute a difference between the last specified amount of motion the CPU 1 0 has 
given to the shoulder-joint pitching-directional actuator 25 in the right hind-ieg block 3D and a concurrent actual amount 
of motion in the pitching direction of the shoulder joint, obtained based on an output from the potentiometer 26 corre- 
sponding to the pitching-directional actuator 25. Next in step SP14, the CPU 10 determines whether the difference 
computed in step SP13 is larger than the preceding difference. 

20 [0168] Thus in steps SP7 to SP1 4, the CPU 10 detemiines, by the second obstacle detecting method, whether the 
robot apparatus 1 has collided with any obstacle. If the CPU 1 0 has detected a collision with an obstacle by obtaining 
an affirmative result of the detemnination in step SP1 0 or SP1 4, it goes to step SP1 6 where it will provide the above- 
mentioned predetermined overturn prevention. 

[0169] Further in step SP17, the CPU 10 changes the difference obtained for the left or right hind-leg block 3C or 
25 3D and concurrently memorized therein to a value obtained in step SP9 or SP14, and then goes to step SP1 where it 

will start again the obstacle detecting procedure RT1 . 

[0170] On the contrary, if the CPU 10 has obtained a negative result of the determination in step SP10 or SP14, 
namely, it has not detected any such collision, it goes to step S PI 5 where it will determine, by the third obstacle detecting 
method, whether the robot apparatus 1 has coiiied with an obstacle. 

30 [0171] Namely in step SP15. the CPU 10 computes, by the formula (1) to (7), each of the concurrent three stability 
margins LI to L3 (in FIG. 33) and determines whether the smallest one of the stability margins LI to L3 is larger than 
a preset threshold. It should be noted that in this embodiment; this threshold is set to 2 (mm). 
[0172] Note that if the result of the determination In step SP1 5 is affirmative, it means that a collision with an obstacle 
has been detected by the third obstacle detecting method. At this time, the CPU 10 goes to step SP16 where it will 

35 provide the aforementioned overturn prevention, then to step SP17 where it will change the difference concurrently 
memorized therein for the left or right hind-leg block 3C or 3D to a value (0) having provisionally been memorized in 
step SP8 or SP12, and returns to step SP1 where it will start the obstacle detecting procedure RT1 again. 
[0173] On the contrary, if the result of the detemnination in step SP15 is negative, it means that no collision of any 
obstacle has been detected by any of the first to third obstacle detecting methods. In this case, the CPU 10 goes to 

40 step SP17 where it will change the difference for the left or right hind-leg block 3C or 3D to the value (0) having 
provisional iy been memorized in step SP8 or SP1 2, and then returns to step SP1 where it will start the obstacle detecting 
procedure RT1 again. 

[0174] The CPU 10 sequentially repeats the obstacle detecting procedure RT1 whilethe robot apparatus 1 iswalking, 
whereby controlling the walking of the robot apparatus 1 so that the latter will not be overturned even when it has 

45 collided with an obstacle. 

(4) Function and effect of the second external force detecting method 

[0175] Based on a specified amount of motion the CPU 1 0 has given to the shoulder-joint pitching-directional actuator 
50 25 of any idling one of the leg blocks 3A to 3D and an actual amount of motion detected based on an output from the 
corresponding potentiometer 26, the CPU 1 0 determines whether the robot apparatus 1 has collided with any obstacle, 
and computes each of the stability margins L1 to L3, which is when no collision with any obstacle has been detected 
by the CPU 1 0 as above, and determines, based on the result of the computation, whether the robot apparatus 1 has 
collided with any obstacle. 

55 [0176] Therefore, in the robot apparatus 1 , the CPU 1 0 detects a collision with an obstacle on the basis of an actual 
state and posture of each of the leg blocks 3A to 3D. Thus, it is possible to detect a collision with an obstacle mush 
more accurately than in the detection of an obstacle through image processing or the like based on image data from 
the CCD camera 20 (as in FIG. 5), for example. 
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[0177] Also in the robot apparatus 1 , an obstacle is detected on the basis of an output from each of the existing 
sensors (shoulder-joint pitching directional potentiometers 26 in the leg blocks 3Ato 3D). Thus, the robot apparatus 1 
according to the present invention can totally be constructed more simple, and can be manufactured with less costs 
and more effectively reduced weight, than a conventional robot apparatus having special force sensors, for example. 

5 [0178] Because of the aforementioned construction of the robot apparatus 1 , it is determined, based on a specified 
amount of motion given to the shoulder-joint pitching directional actuator 25 In an Idling one of the leg blocks 3A to 3D 
and an actual amount of motion detected based on an output from the potentiometer 26 corresponding to the actuator 
25, whether the robot apparatus 1 has collided with an obstacle. When any collision with an obstacle cannot have been 
detected by this system, the stability margins L1 to L3 are computed and it is determined, based on the results of 

10 computation, whether any obstacle has been detected. Thereby, it Is possible to detect a collision with an obstacle 
positively without any complicated detecting mechanism, and thus It is possible to provide a robot apparatus having a 
simplified construction and capable of walking stably even on an irregular surface. 

(5) Other embodiments 

15 

[0179] In the foregoing, the present invention has been described concerning its application to the robot apparatus 
1 constructed as shown in FIG. 4, namely, to quadruped robots. However, the present invention is not limited to this 
embodiment but can widely be applied to bipedal and other types of robots. 

[0180] Also, the present invention has been described concerning the embodiment in which the first to third obstacle 
20 detecting methods are used in combination. However, the present invention is not applied to this embodiment but may 

be applied to use of one or two selected from the first to third obstacle detecting methods, 

[0181] Further, the present invention has been described concernlngthe embodiment in which an obstacle is detected 
on the basis of specified and actual amounts of motion concerning the shoulder-joint pitching-directional actuator 25 
in each of the leg blocks 3A to 3D. However, the present invention is not limited to this embodiment but may be applied 

25 to detecting a collision with an obstacle based on specified and actual amounts of motion concerning the shoulder- 
joint pitching-directional actuator 25 in each of the leg blocks 3A to 3D or on specified and actual amounts of motion 
concerning the knee-joint mechanism actuator 25. In short, for detecting a collision with an obstacle based on an 
amount of motion specified to an actuator which actuates a predetemriined joint mechanism in a robot apparatus de- 
signed to walk while actuating the predetermined joint mechanism as necessary, and an actual amount of motion the 

30 actuator has done, an appropriate one may be selected as the actuator from a wide variety of actuators, 

[0182] Further, the present invention has been described concerning the embodiment in which the single CPU 10 
works as the controller to give the shoulder-joint pitching-directional actuator 25 an amount of motion specified to the 
actuator 25, the means for determining, based on the specified and actual amounts of motion, whether there exists an 
obstacle, and as the means for computing the distances (stability margins) L1 to L3 from the sides TRE1 to TRE3 of 

35 the triangle TR (any other polygon in casethe robot apparatus 1 is a one having four or more legs) defined by connecting 
the points PA, PB and PD where three of the leg blocks 3A to 3D are on the ground surface to the projected point PG, 
on the walking surface, of the center of gravity of the robot apparatus. However, the present invention is not limited to 
this embodiment but these functions of the CPU 10 may be provided separately from each other. 
[0183] Moreover, the present invention has been described concerning the embodiment in which the potentiometer 

40 26 is used to detect an actual amount of motion the actuator has done. However, the present Invention Is not limited 
to this embodiment but the detecting means may be any one other than the potentiometer, which would be appropriate 
for the type of an actuator selected for use in the robot apparatus 1 . 

[0184] Furthennore, the present invention has been described concerning the embodiment in which when an obstacle 

cannot have been detected by the first and second obstacle detecting methods, the third obstacle detecting means Is 
45 used to detect the obstacle. However, the present invention is not limited to this embodiment but the first to third obstacle 
detecting methods may be used in any sequence other than above to detect an obstacle or all the methods may be 
used simultaneously. 

Industrial Applicability 

50 

[0185] As having been described in the foregoing, the robot apparatus according to the present invention includes 
an actuator whose motion is controlled with a control signal, a controlling means for outputting the control signal under 
which the actuator is caused to do a predetermined motion, and means for detecting an external force on the basis of 
a change shown by the control signal when the external force is applied to the actuator. It can detect an external force 
55 without having to use any dedicated sensors for the external force detection but on the basis of the control signal for 
controlling the operation of the robot apparatus. 

[0186] Also, the robot apparatus according to the present Invention further includes a joint mechanism actuated by 
the actuator, a motion controlling means for specifying, to the actuating means, an amount of motion for actuating the 
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joint mechanism, and means for detecting an actual amount of motion tlie actuator has done for actuating the joint 
mechanism. By detennining, based on the specified and actual amounts of motion, whether there exists an obstacle, 
it is possible to detect an obstacle without any complicated mechanism, Also, since the obstacle detection is made 
based on an amount of motion specified to the actuator and an actual amount of motion the actuator has done, it is 

5 possible to positively detect an actual physical collision with an obstacle. 

[0187] The robot apparatus according to the present invention further Includes a plurality of leg blocks actuated in 
predetermined patterns, respectively, and means for computing a distance from each side of a polygon defined by 
connecting landing points of landing ones of the plurality of leg blocks to a projected point, on a walking surface, of the 
center of gravity of the robot apparatus. By determining, based on the distances from the sides of the polygon, computed 

10 by the computing means, whetherthere exists an obstacle, it Is possible to positively a physical collision with an obstacle 
without any additional dedicated part, and a collision with an obstacle by a simple mechanism. 
[0188] The robot apparatus-operation controlling method according to the present invention includes steps of con- 
trolling the motion of an actuator of the robot apparatus with a control signal, and detecting an external force to the 
robot apparatus on the basis of a change shown by the control signal when the external force is applied to the robot 

15 apparatus. An external force can be detected without having to use any dedicated sensors for the external force de- 
tection but on the basis of the control signal for controlling the operation of the robot apparatus. 
[0189] Also, the robot apparatus-operation controlling method according to the present invention further includes 
steps of specifying, to the actuator, an amount of motion for actuating a joint mechanism, and detecting an actual 
amount of motion the actuator has done for actuating the joint mechanism. By determining, based on the specified and 

20 actual amounts of motion, whether an external force has been applied to the robot apparatus, it is possible to detect 
an external force without any complicated mechanism, and also possible to positively an actual physical collision with 
an obstacle. Thus, a collision with an obstacle can positively be detected by a simple mechanism. 
[0190] Also the robot apparatus-operation controlling method further includes steps of having the robot apparatus 
walk by actuating a plurality of leg blocks in predetemiined patterns, respectively, and computing a distance from each 

25 side of a polygon defined by connecting landing points of landing ones of the plurality of leg blocks to a projected point, 
on a walking surface, of the center of gravity of the robot apparatus. By determining, based on the distances from the 
sides of the polygon, computed by the computing means, whether there exists an obstacle, it is possible to positively 
detect a physical collision with an obstacle can positively be detected without any additional dedicated part, and a 
collision with an obstacle by a simple mechanism. 

30 [0191] The externa! force sensor according to the present invention includes means for actuating each portion of a 
robot apparatus, a controlling means for specifying, to the actuating means, an amount of motion for actuating the 
robot- apparatus portion, means for detecting an actual amount of motion the actuating means has done, and means 
for determining, on the basis of the specified and actual amounts of motion, whether or not an external force has been 
applied to the robot apparatus. Thus, it is possible to detect an obstacle without any complicated mechanism, and also 

35 possible to positively detect an actual physical collision with an obstacle, and a collision with an obstacle by a simple 
mechanism. 

[0192] The program according to the present invention causes a robot apparatus to control the motion of an actuator 
thereof with a control signal, and detect an external force to the robot apparatus on the basis of a change shown by 
the control signal when the external force is applied to the robot apparatus. It can detect an external force without 
40 having to use any dedicated sensors for the external force detection but on the basis of the control signal for controlling 

the operation of the robot apparatus. 

[0193] The recording medium according to the present invention has recorded therein a program which causes a 
robot apparatus to control the motion of an actuator thereof with a control signal, and detect an external force to the 

robot apparatus on the basis of a change shown by the control signal when the external force is applied to the robot 
45 apparatus. The robot apparatus caused to operate as above under the program recorded in the recording medium can 
detect an external force without having to use any dedicated sensors for the external force detection but on the basis 
of the control signal for controlling its own operation. 

[0194] The external force detecting method according to the present Invention Includes steps of supplying means 

for actuating each portion of a robot apparatus with an amount of motion specified to actuating the robot-apparatus 
50 portion, detecting an actual amount of motion the actuating means has done for actuating the portion, and determining 
whether or not an external force has been applied to the robot apparatus, on the basis of the specified and actual 
amounts of motion. By determining, based on the specified and actual amounts of motion, whetherthere exists an 
obstacle, it is possible to detect an obstacle without any complicated mechanism. Also, it is possible to positively detect 
an actual physical collision with an obstacle, and a collision with an obstacle by a simple mechanism. 

55 
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Claims 

I, A robot apparatus comprising: 

5 an actuator whose motion is controlled with a control signal; 

a controlling means for outputting the control signal which causes the actuator do a predetermined motion; and 
means for detecting an external force on the basis of a change shown by the control signal when the external 
force is applied to the actuator. 

10 2. The apparatus as set forth in claim 1 , wherein the external force detecting means detects an external force on the 
basis of the control signal change according to a processing program. 

3. The apparatus as set forth in claim 1, wherein the external force detecting means detects the direction and/or 
magnitude of the external force. 

15 

4. The apparatus as set forth in claim 1 , wherein the'controiiing means controls the actuating means to autonomously 
operate when the externa! force detecting means detects a predetermined external force. 

5. The apparatus as set forth in claim 1 . wherein: 

20 

the control signal is a PWiVl (pulse width modulation) pulse having the width thereof modulated by data; and 
the external force detecting means detects an external force on the basis of a change in width shown by the 
PWM pulse when the external force Is applied to the actuating means. 

25 6. The apparatus as set forth in claim 1 , further comprising: 

a joint mechanism actuated by the actuator; 

a motion controlling means for specifying, to the actuating means, an amount of motion for actuating the joint 
mechanism; and 

30 means for detecting an actual amount of motion the actuator has done for actuating the joint mechanism; 

the external force detecting means detecting whether or not an external force has been applied to the actuator, 
on the basis of the amount of motion specified to the actuator by the motion controlling means and the actual 
amount of motion having been done by the actuator and detected by the motion detecting means. 

35 7. The apparatus as set forth in claim 6, wherein the joint mechanism is a shoulder joint mechanism of a leg block. 

8. The apparatus as set forth in claim 6, wherein the actuator Is to actuate the leg blocl< in the pitch direction. 

9. The apparatus as set forth In claim 6, further comprising means for providing a predetermined tumbling prevention 
40 when an external force Is detected by the external force detecting means. 

10. The apparatus as set forth in claim 6, further comprising: 

a plurality of leg blocks actuated in predetermined patterns, respectively; and 
45 means for computing a distance from each side of a polygon defined by connecting landing points of landing 

ones of the plurality of leg blocks to a projected point, on a walking surface, of the center of gravity of the robot 
apparatus; 

the external force detecting means determining whether or not an external force Is applied to the robot appa- 
ratus, on the basis of the specified and actual amounts of motion, and the distance from each side of the 
50 polygon to the projected point, computed by the distance computing means, 

II . A method of controlling the operation of a robot apparatus, comprising steps of: 

controlling the motion of an actuator thereof with a control signal; and 
55 detecting an external force to the robot apparatus on the basis of a change shown by the control signal when 

the external force is applied to the robot apparatus. 

12. The method as set forth in claim 11 , wherein in the external force detecting step, there is detected an external 
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force on the basts of the control signal change according to a processing program. 

13. The method as set forth in claim 1 1 , wherein in the external force detecting step, there are detected the direction 
and/or magnitude of the external force. 

5 

14. The method as set forth in claim 11 , wherein: 

the control signal is a PWM (pulse width modulation) pulse having the width thereof modulated by data; and 
in the external force detecting step, there is detected an external force on the basis of a change in width shown 
10 by the PWM pulse when the external force Is applied to the actuating means. 

15. The method as set forth in claim 11 , further comprising steps of: 

specifying, to the actuator, an amount of motion for actuating a joint mechanism; and 
15 detecting an actual amount of motion the actuator has done for actuating the joint mechanism; 

in the external force detecting step, there being detected whether or not an external force has been applied 
to the actuator, on the basis of the amount of motion specified to the actuator in the motion controlling step 
and the actual amount of motion made by the actuator and detected in the motion detecting step. 

20 16. The method as set forth in claim 15, wherein the joint mechanism is a shoulder joint mechanism of a leg block. 

17. The method as set forth in claim 15, wherein the actuator is to actuate the leg block in the pitch direction. 

18. The method as set forth in claim 15, further comprising a step of providing a predetermined tumbling prevention 
25 when an external force is detected in the external force detecting step. 

19. The method as set forth in claim 15, further comprising steps of: 

having the robot apparatus walk by actuating a plurality of leg blocks in predetermined patterns, respectively; 
30 and 

computing a distance from each side of a polygon defined by connecting landing points of landing ones of the 
plurality of leg blocks to a projected point, on a walking surface, of the center of gravity of the robot apparatus; 
in the external force detecting step, there being determined whether or not an external force is applied to the 
robot apparatus, on the basis of the specified and actual amounts of motion, and the distance from each side 
35 of the polygon to the projected point, computed by the distance computing means. 

20. An external force detecting apparatus comprising: 

means for actuating each portion of a robot apparatus; 
40 a controlling means for specifying, to the actuating means, an amount of motion for actuating the portion; 

means for detecting an actual amount of motion the actuating means has done; and 
means for determining, on the basis of the specified and actual amounts of motion, whether or not an external 
force has been applied to the robot apparatus,. 

45 21. An external force detecting method comprising steps of: 

specifying, to means for actuating each portion of a robot apparatus, an amount of motion for actuating the 
portion; 

detecting an actual amount of motion the actuating means has done for actuating the portion; and 
50 determining whether or not an external force has been applied to the robot apparatus, on the basis of the 

specified and actual amounts of motion. 

22. A program causing a robot apparatus to: 

55 control the motion of an actuator thereof with a control signal; and 

detect an external force to the robot apparatus on the basis of a change shown by the control signal when the 
external force is applied to the robot apparatus. 
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23. The program as set forth in claim 22, wherein in the externa! force detecting step, there is detected an external 
force on the basis of the control signal change according to a processing program. 

24. The program as set forth in claim 22, wherein: 

5 

the control signal is a PWM (pulse width modulation) pulse having the width thereof modulated by data; and 
in the external force detecting step, there is detected an external force on the basis of a change in width shown 
by the PWM pulse when the external force Is applied to the actuating means. 

10 25. A recording medium having recorded therein a program which causes a robot apparatus to: 

control the motion of an actuator thereof with a control signal; and 

detect an external force to the robot apparatus on the basis of a change shown by the control signal when the 
external force is applied to the robot apparatus. 

15 

26. The recording medium as set forth in claim 25, wherein in the external force detecting step, there is detected an 
external force on the basis of the control signal change according to a processing program. 

27. The recording medium as set forth in claim 25, wherein: 

20 

the control signal is a PWIVI (pulse width modulation) pulse having the width thereof modulated by data; and 
in the external force detecting step, there is detected an external force on the basis of a change in width shown 
by the PWI^^ pulse when the external force Is applied to the actuating means. 

25 

Amended claims under Art. 19.1 PCI 

1. (Amended) An autonomously behaving robot apparatus comprising: 

30 a body; 

a plurality of actuators connected to the body and each having a joint drive; 
means for controlling the actuator based on a predetermined control signal; 

a storage means having stored a relation between the control signal and a measured value of a torque on the 
joint drive; 

35 a storage means having stored a relation between a force applied to the actuator and a computed value of a 

torque on each joint drive based on the force application; and 

an external force detecting means for computing the measured torque value on the basis of a change of the 
control signal and detecting a direction and magnitude of the force applied to the actuator from the relation 
between the computed measured torque value and computed torque value. 

40 

2. (Amended) The apparatus as set forth in claim 1 , wherein the control signal is a PWM (pulse width modulation) 
pulse. 

3. (Amended) The apparatus as set forth in claim 1 , further comprising: 

45 

a plurality of leg blocks to be driven in a predetennined pattern; and 

means for computing a distance from each side of a polygon defined by connecting landing points of landing 
ones of the plurality of leg blocks to a projected point, on a walking surface, of the center of gravity of the robot 

apparatus: 

50 the external force detecting means determining whether or not an external force is applied to the robot appa- 

ratus, on the basis of the specified and actual amounts of motion, and the distance computing means-computed 
distance from each side of the polygon to the projected point. 

4. (Amended) A method of controlling the operation of an autonomously behaving robot apparatus, comprising 
55 steps of 

controlling a plurality of actuators connected to the body unit and each having a joint drive with the use of a 
predetermined control signal; and 
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computing, on the basis of a cliange of the control signal, the nneasured torque value with the use of a storage 
means having stored therein a relation between the control signal and a measured value of a torque developed 
at the joint drive and a storage means having stored therein a relation between a force applied to the actuator 
and a computed value of a torque developed at each joint drive due to the force application and detecting a 
5 direction and magnitude of the force applied to the actuator from the relation between the computed measured 

torque value and computed torque value. 

5. (Amended) The method as set forth in claim 4, wherein the control signal is a PWM (pulse width modulation) 
pulse. 

10 

6. (Amended) The method as set forth in claim 4, wherein the robot apparatus has a plurality of leg blocks to be 

driven in a predetermined pattern, and further comprising steps of: 

computing a distance from each side of a polygon defined by connecting landing points of landing ones of the 
^5 plurality of leg blocks to a projected point, on a walking surface, of the center of gravity of the robot apparatus; 

and 

determining whether or not an external force is applied to the robot apparatus, on the basis of the specified 
and actual amounts of motion, and the distance computing means-computed distance from each side of the 
polygon to the projected point. 

20 
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if ForceKind =s ForceToFoot 
If BehaviorStatus s= Walking 

Command(StopWalking); 
If BehaviorStatus ss Standing 

Command(HandsUp); 

If ForceKind ss ForceToBody 

if BeliaviorStatus == Standing 
If ForceDirection ss Backward 

Command(SitDown); 
If ForceDirection == Forward 

Command(LieDown); 
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FIG.1 1 
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